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Objective 


The  objective  of  this  research  is  to  develop  a  computational  framework  for 
simplified  path  planning  and  near-optimal  guidance  law  development  for  problems 
with  nonholonomic  constraints  using  a  synthesis  of  orthogonal  collocation  methods 
and  computational  differential  geometry.  A  secondary  objective  of  this  research  is 
to  develop  a  theoretical  foundation  for  orthogonal  collocation  methods  to  enhance 
the  ability  to  employ  differential  geometric  techniques  in  developing  simplified  path 
plans.  This  research  is  highly  relevant  to  future  Army  needs  in  autonomous  ground 
vehicle  mission  planning,  guidance,  and  control. 


Approach 


The  technical  approach  developed  in  the  proposed  research  combines  advanced 
numerical  methods  for  solving  optimal  control  problems  with  computational 
differential  geometry.  In  particular,  orthogonal  collocation  methods,  which  have 
been  shown  to  have  high  accuracy  in  both  the  primal  and  dual  solutions,  will  be 
used  to  determine  extremal  trajectories  to  constrained  nonlinear  optimal  control 
problems.  Then,  exploiting  the  accuracy  of  the  dual  solution,  the  Hamiltonian 
dynamics  corresponding  to  the  optimal  control  problem  can  be  analyzed  using 
approaches  from  nonlinear  dynamical  system  theory.  Specifically,  finite-time 
Lyapunov  exponents  can  be  used  to  develop  insight  into  the  regions  where  the 
various  time-scales  in  the  problem  are  active  while  finite-time  Lyapunov  vectors  can 
be  used  to  extract  the  differential  geometric  structure  in  the  problem.  The 
synthesized  framework  provides  a  novel  way  to  access  the  structure  of  the 
Hamiltonian  dynamics,  but  without  ever  having  to  solve  the  (often  intractable) 
Hamiltonian  boundary-value  problem  that  arises  from  the  calculus  of  variations. 
Extraction  of  time-scale  and  differential  geometric  structure  in  the  Hamiltonian 
system  then  provides  a  novel  opportunity  to  reduce  the  complexity  of  the  model  and 
arrive  at  simplified  guidance  laws. 
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Scientific  Barriers 


The  analysis  of  Hamiltonian  systems  is  an  important  part  of  understanding  and 
characterizing  the  structure  of  optimal  path  planning  problems.  Moreover,  the  vast 
majority  of  complex  optimal  path  planning  problems  are  nonlinear,  have  no  closed- 
form  analytic  solutions,  and  thus  must  be  solved  and  analyzed  computationally  (i.e., 
using  numerical  methods).  The  scientific  barriers  in  this  research  are  (1)  the  ability 
to  obtain  accurate  approximations  to  Hamiltonian  phase  space  trajectories  that 
arise  in  nonlinear  optimal  path  planning  problems;  (2)  the  ability  to  analyze  the 
optimal  path  plans  in  order  to  better  characterize  the  underlying  structure  of  the 
optimally  controlled  systems;  and  (3)  a  convergence  theory  for  the  numerical 
methods  used  to  determine  the  optimal  path  plans. 


Significance 


The  significance  of  the  results  of  this  research  will  be  an  advanced  computational 
framework  for  developing  autonomous  path  planning,  guidance,  and  control 
algorithms  in  future-generation  unmanned  Army  ground  vehicles.  In  particular,  the 
motion  of  unmanned  wheeled  ground  vehicles  is  governed  by  highly  nonlinear 
differential  equations  and  these  vehicles  operate  in  highly  constrained 
environments.  Moreover,  because  of  the  requirement  for  autonomy,  the  demands  of 
the  on-board  guidance  system  is  significantly  higher  as  compared  to  vehicles 
operated  by  humans.  Because  of  the  required  sophistication  of  the  modeling 
together  with  the  required  performance,  it  is  difficult  to  conceive  simplified  path 
planning  and  guidance  algorithms  for  autonomous  ground  vehicles  using  purely 
analytical  methods.  As  a  result,  computational  methods  that  enable  extraction  of 
simplified  guidance  laws  are  of  great  benefit  to  the  Army.  The  proposed  framework 
will  be  an  enabling  technology  for  simplified  path  planning  and  guidance  for 
unmanned  ground  vehicles,  leading  to  the  use  of  these  algorithms  on  board  future 
Army  vehicles. 


Accomplishments 


The  following  key  aspects  of  the  research  were  accomplished  this  past  year: 

•  A  new  global  orthogonal  collocation  method  for  solving  nonlinear  finite- 
horizon  and  infinite-horizon  optimal  control  problems  using  collocation  at 
Legendre-Gauss-Radau  (LGR)  points  has  been  researched  and  developed. 
The  results  of  this  research  are  being  presented  at  a  mini-symposium  on 
pseudospectral  methods  at  the  2009  SIAM  Annual  meeting  in  Denver, 
Colorado  and  have  been  submitted  for  journal  publication  as  given  in  Ref.  [1]. 
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Progress  has  also  been  made  toward  developing  a  unified  framework  for  the 
solution  of  optimal  control  problems  using  orthogonal  collocation  methods 
and  a  journal  article  detailing  the  results  of  this  research  is  currently  being 
written.  This  research  will  provide  a  rigorous  basis  for  the  reliable  solution 
of  complex  optimal  control  problems  that  arise  in  autonomous  ground 
vehicle  mission  planning,  guidance,  and  control. 

•  A  preliminary  study  of  time-scale  and  differential  geometric  analysis  in 
vehicle  dynamics  applications.  A  conference  paper  on  this  research  was 
published  as  given  in  Ref.  [2].  Currently,  this  work  is  being  transformed  into 
a  form  suitable  for  journal  publication.  Finally,  we  are  currently  researching 
problems  with  nonholonomic  constraints  and  plan  to  have  at  least  one  article 
on  the  topic  later  in  the  year. 

•  An  open-source  mathematical  software  for  solving  multiple-phase  optimal 
control  problems  was  developed.  An  article  detailing  the  results  of  this 
research  has  been  accepted  for  journal  publication  as  given  in  Ref.  [3]. 


Collaborations  and  Leveraged  Funding 


There  are  no  collaborations  of  this  research  with  other  organizations  or  individuals. 
Leveraged  funding  for  this  research  includes  student  fellowship  and  teaching 
assistantship  funds  provided  by  The  University  of  Florida. 
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Conclusions 


The  progress  this  past  year  on  this  research  has  been  excellent.  We  have  developed 
a  new  method  for  solving  optimal  control  problems,  made  significant  progress 
characterizing  the  methods  used  in  this  research,  applied  the  methodologies  to 
problems  of  relevance  to  the  U.S.  Army,  and  developed  a  new  software  platform  for 
wide  use  in  the  academic,  government,  and  not-for-profit  research  communities. 


Technology  Transfer 


The  key  technology  transfer  that  has  been  provided  by  this  research  is  the 
aforementioned  open-source  software  tool  GPOPS  (see  Ref.  [3])  which  is  available 
for  worldwide  download  at  http://sourceforge.net/proiects/gpops.  Further 
information  about  GPOPS  can  be  found  at  http:  //gpops.sourceforge.net. 
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